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ABSTRACT 



A device for non-contacting measurement of the orien- 
tation in space of a movable measuring object, such as 
the end-effector of a robot, uses a retro-reflector having 
three mutually orthogonal reflecting surfaces. This re- 
tro-reflector is rigidly attached to the measuring object 
Reference marks are provided on the retro-reflector. A 
laser emits a laser beam. A beam expander optical sys- 
tem in the path of the laser beam provides a coilimated 
light beam of larger diameter than that of said laser 
beam. The light beam passes through a stationary sec- 
tion, where the path of rays of the light beam is station- 
ary, to a beam directing device. The beam directing 
device directs coilimated light beam onto the retro- 
reflector. The light beam is returned by the retro-reflec- 
tor substantially into itself. The beam directing means 
has movable reflecting surfaces for tracking, with said 
light beam, the movable measuring object. A semi- 
transparent mirror is arranged in the stationary section 
of the returned light beam for deflecting part of this 
returned light beam to a plane where a picture with a 
pattern caused by the reference mark is formed. A pic- 
ture detector is arranged in this plane, and detects the 
picture of the reference mark and provides correspond- 
ing picture information. A processor derives, from this 
picture information, output data representing the orien- 
tation in space of the retro-reflector and thereby the 
orientation in space of the measuring object. 

22 Claims, 14 Drawing Sheets 




04/10/2003, EAST Version: 1.03.0002 



U.S. Patent 



Nov. 30, 1993 Sheet 1 of 14 5,267,014 




04/10/2003, EAST Version: 1.03.0002 



U.S. Patent Nov. 30, 1993 Sheet 2 of 14 5,267 




04/10/2003, EAST Version: 1.03.0002 



U.S. Patent Nov. 30, 1993 Sheet 3 of 14 5,267, 




04/10/2003, EAST Version: 1.03.0002 



U.S. Patent Nov. 30, 1993 sheet 4 of 14 5,267,014 




04/10/2003, EAST Version: 1.03.0002 



U.S. Patent Nov. 30, 1993 Sheet 5 of 14 5,267,014 




04/10/2003, EAST Version: 1.03.0002 



U.S. Patent 



Nov. 30, 1993 Sheet 6 of 14 5,267,014 



CO 




04/10/2003, EAST Version: 1.03.0002 



U.S. Patent 



Nov. 30, 1993 



Sheet 7 of 14 



5,267,014 




04/10/2003, EAST Version: 1.03.0002 



U.S. Patent Nov. 30, 1993 Sheet 8 of 14 5,267,014 




04/10/2003, EAST Version: 1.03.0002 



U.S. Patent Nov. 30, 1993 Sheet 9 of 14 5,267 



NO 




04/10/2003, EAST Version: 1.03.0002 



U.S. Patent Nov. 30, 1993 Sheet 10 of 14 5,267,014 




04/10/2003, EAST Version: 1.03.0002 



U.S. Patent Nov. 30, 1993 Sheet 11 of 14 5,267,014 




04/10/2003, EAST Version: 1.03.0002 



U.S. Patent 



No?. 30, 1993 



Sheet 12 of 14 



5,267,014 




04/10/2003, EAST Version: 1.03.0002 



U.S. Patent Nov. 30, 1993 Sheet 13 of 14 5,267,014 




04/10/2003, EAST Version: 1.03.0002 



U.S. Patent Nov. 30, 1993 



Sheet 14 of 14 



5,267,014 




04/10/2003, EAST Version: 1.03.0002 



5,267,014 

1 2 

These two systems require active elements on the 
POSITION AND ORIENTATION MEASUREMENT end-effector of the robot. Such elements add weight to 
DEVICE the end-effector. There is also the problem of transmit- 
ting signals to and from the end-effector. 
TECHNICAL FIELD 5 A thesis by S. Decker "Dynaroisches extemes Robo- 
The invention relates to a device for non-contacting terbahnmeBsystera— Ein Beitrag zur Bestimmung 
measurement of the orientation in space of a measuring dynamischer KenngroBen von Industrierobotern" 
object. In particular, the invention relates to the posi- Technische Univcrsitat Wien, describes a laser tracking 
tion and orientation measurement of industrial robots by system which permits the tracking of the three degrees 
laser tracking techniques in six degrees of freedom. 10 of freedom of position. A robot carries, at its tool center 
Part of this invention has been presented in a paper point, a retro-reflector. The laser beam of an interfer- 
"Real Time 6DOF Measurement Of Robot End-Effec- ometer is deflected by a mirror to this retro-reflector, 
tors" by J. P. Prenninger, H. Gander and M. Vincze on The mirror can be rotated about two axes to track the 
the International Robot & Vision Automation Show & retro-reflector. The laser beam is returned by the retro- 
Conference, Detroit, Mich., USA, Oct. 22-24, 1991. reflector to the mirror and to the interferometer. The 
The subject matter of the invention has also been parallel displacement between the incident and returned 
described in my thesis "Position and Orientation Mea- beam is proportional to the distance of the incident 
surement of Industrial Robots Using Laser Tracking beam from the center point of the reflector. This dis- 
Techniques in 6 Degrees of Freedom" submitted to the 2Q placement is measured by means of a position sensitive 
Technische Universitat Wien in May 1992. detector, onto which part of the returned beam is de- 
BACKGROUND ART fleeted by a semi-transparent mirror. The signal of the 

position sensitive detector is the error signal of a control 

There are guidelines and draft international standards device which rotates the mirror so as to rninimize the 

regarding the measurement of industrial robots. 25 displacement between incident and returned beam. 

Such guidelines include the "VDI-Richtlinion VDI Thereby the deflected laser beam is caused to follow 

3861" "KenngroBen fur Handhabungsgerate" Sheet 1 arbitrary movements of the retro-reflector. The laser 

(1980), "KenngroBen fur Industrieroboter, Einsatzspex- hcm "tracks" the retro-reflector. Using the distance 

ifische KenngroBen" Sheet 2 (1987) and "KenngroBen bctwecn mirror and rctro .reflector as provided by the 

™ dusinc !°^°l^ P ™ f " n * d \ r KenngroBen" Sheet 3 30 interferometer and the angles of rotation of the mirror 

(1987) issued by Verem Deutscher Ingen.eure provided by tw0 hign . pTCcision angular encoders, the 

*9 a D ? ft ^eniation^ Standard ISO/- three-dimensional position of the retro-reflector in an 

DIS 9283 Manipu ating industrial robots-perfor- i nstrU ment-fixed reference coordinate system is com- 

mance criteria and related test methods", issued by the pu t e d 

Int ™" for Stand ardization (1988) 35 ^ rfor m ^ trackj jdcs ^ &e 
, L ^SSySSSoSf P Qsiti ° n ° f * e rctro-rcflector ami, thereby, of the end- 
(1986) and Lasergestutzte Positions- und Bahnvermes- t > ^ ^n^*^ 
sung von Industrierobotern" Thesis, Universitat Karls- UOn ° f the *«™* n '<*^ 
ruhe (1988) describe a measuring system for robots. 40 DISCLOSURE OF THE INVENTION 
This measuring system is based on a conventional inter- lt - v . t r . , . . 
ferometer. The measuring system is capable of measur- *Z ? J % pT<m *\™ T 
ing in six degrees of freedom. Tne measuring system P™" 1 d™ce for non-contacting measurement of the 
consists of a fixed interferometer and a carrier mounted on T entatlon ,n s P ace ° f ? measuring object, 
on the tool center point. There is a laser beam of the 45 } l " * ^ mention to provide 
interferometer. A second beam is emitted by a semicon- a dcv,ce for non-contacting measurement of the onenta- 
ductor laser diode parallel to the interferometer laser tlon m s P ace of a measunn S object wherein only passive 
beam. The carrier contains an optical system, which dements need to be attached to the object, 
projects both laser beams on three position sensitive 14 ,s anothcr ob J ect of the mention to further modify 
detectors. All angles of orientation can be determined 50 the pnor art laser trackin g svstem discussed hereinbe- 
unambiguously from the signals provided by the posi- fore t0 P crmit measurement of six degrees of freedom, 
tion sensitive detectors. In combination with the inter- namely both position and orientation, 
ferometer, the deviation of the movement of the robot According to the broad concept of the invention, the 
from a reference trajectory can be measured in six de- device comprises a retro-reflector rigidly attached to 
grees of freedom. 55 ^d object, reference mark means provided on said 
A laser tracking system measuring more than three retro-reflector, light source means for generating a col- 
degrees of freedom is described in a paper by Kam Lau, limated light beam, beam directing means for directing 
Robert Hocken and Leonard Haynes "Robot Perfor- collimated light beam onto said retro-reflector, said 
mance Measurements using Automatic Laser Tracking ^8 nt beam being returned by said retro-reflector sub- 
Techniques" in "Robotics and Computer-Integrated 60 stantially into itself, means receiving said returned light 
Manufacturing" Vol. 2 No. j pp. 227-236 (1985). A beam for forming therefrom a picture of said reference 
laser beam is deflected by a cardanically mounted first mark means, picture detecting means for detecting said 
mirror. A plane second mirror is mounted on the end- picture of said reference mark means and for providing 
effector of a robot. This second mirror can be rotated corresponding picture information, and processing 
about two axes. The mirror is rotated by a servo system 65 means for deriving, from said picture information, out- 
to be always perpendicular to the laser beam. The dis- put data representing the orientation in space of said 
tance between the two mirrors is measured interfero- retro-reflector and thereby the orientation in space of 
metrically. said measuring object. 
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It has been found, that the pattern observed by the rotatable with said first and second reflecting surfaces 

picture detecting means permits unambiguous determi- and being arranged to re-deflect said light beam into the 

nation of the orientation of the retro-reflector in space. direction of a second axis of rotation orthogonal to said 

In a preferred embodiment of the invention, said first axis of rotation, and a fourth reflecting surface in 
retro-reflector comprises three mutually orthogonal 5 said re-deflected light beam on said second axis of rota- 
reflecting surfaces. As the orientation of the retro- tion, said fourth reflecting surface being rotatable about 
reflector is measured, said retro-reflector can be a solid said second axis of rotation to direct said light beam 
body of transparent material having three mutually radially therefrom. 

orthogonal surfaces, said orthogonal surfaces reflecting Preferred embodiments of the invention will now be 
light by total reflection and representing said reflecting 10 described with reference to the accompanying draw- 
surfaces. Said reference mark means may be reduced- ings. 
reflection strips along adjacent edges of said reflecting 

surfaces. Said reference mark means may, however* BRIEF DESCRIPTION OF THE DRAWINGS 

comprise separate bodies attached to said retro-reflec- FIG. 1 is a schematic illustration of a laser tracking 

tor and extending into said light beam. Said attached 15 system with a device for non-contacting measurement 

bodies define elongated structures. of the orientation in space of a measuring object 

Said light source means may comprise a laser emit- FIG. 2 is a schematic-perspective illustration of the 
ting a laser beam. Preferably, said light source means device for the measurement of the orientation of a retro- 
further comprise beam expander means in the path of reflector rigidly attached to the measuring object 
the laser beam for providing a collimated light beam of 20 FIG. 3 is a typical example of a picture or pattern 
larger diameter than that of said laser beam. obtained from the returned light beam and showing the 

Said light beam passes through a stationary section, marks on the retro-reflector, these marks consisting, in 

where the path of rays of the light beam is stationary, this case, of blackened edges of the reflecting surfaces 

said means for receiving said returned light beam com- forming the retro-reflector. 

prising semi-transparent mirror means arranged in said 25 FIG. 4 is a more detailed illustration of the interfer- 

stationary section of said returned light beam for de- ometer used in the device of FIG. 1. 

fleeting part of said returned light beam to a plane FIGS. 5(A)-5(C) illustrate the meaning of the pitch, 

where a picture with a pattern caused by said reference roll and yaw angles used to describe the orientation of 

mark means is formed, said picture detecting means the measuring object relative to a device-fixed reference 

being arranged in said plane. Said detecting means may 30 coordinate system. 

comprise a CCD sensor. In one embodiment, said CCD FIG. 6 illustrates the designation of the various an- 

sensor comprises a number of line scan sensors. gles observed in the picture of the marks generated by 

Said beam directing means comprise movable reflect- the beam returned by the retro-reflector, 

ing means for tracking, with said light beam, said mea- FIG. 7 shows, in an illustration similar to FIG. 2, a 

suring object, which is movable, The tracking is 35 different type of marks applied to the retro-reflector, 

achieved by detector means responsive to the lateral FIG. 8 is a typical example of a picture or pattern 

offset of the incident and returned beams caused by the obtained from the returned light beam and showing the 

reflection at said reflecting surfaces of said retro-reflec- marks applied to the retro-reflector of FIG. 6. 

tor, and servo means controlled by said detector means FIG. 9 shows, in an illustration similar to FIG. 2, still 

for moving said reflecting means to reduce this lateral 40 another type of marks applied to the retro-reflector, 

offset to zero and thereby to track said retro-reflector FIG. 10 shows, in an illustration similar to FIG. 2, a 

with said light beam. In addition, the device includes further type of marks applied to the retro-reflector, 

interferometer means for measuring the distance of said FIG. 11 shows, in an illustration similar to FIG. 2, a 

measuring object from said light source means to pro- retro-reflector with a wire attached thereto as a mark, 

vide a distance information. There are means for sensing 45 FIG. 12 shows, in an illustration similar to FIG. 2, 

the movement of said movable reflecting means of said another arrangement of with a position sensitive detec- 

beam directing means to provide beam direction infor- tor in addition to a CCD picture sensor, 

mation, and computing means, to which said distance FIG. 13 shows, in an illustration similar to FIG. 2, 

information and said direction information is applied to still another arrangement with line scan CCD sensors, 

provide output data indicative of the position of said 50 FIGS. 14A and 14B illustrate the information ob- 

retro-reflector, and thereby of said measuring object. tained with an arrangement of FIG. 12. 

Said beam directing means may comprises a cardani- FIG, 15 is a schematic-perspective view of a modified 

cally mounted mirror, said mirror being movable by a design of the device for deflecting the laser beam 

first servomotor about a first cardan axis and being towards the retro-reflector. 

movable by a second servomotor about a second cardan 55 FIG. 16 is a schematic-perspective view similar to 

axis. In another embodiment, said beam directing means FIG. 15 and illustrates the angles of rotation of the 

comprises a first reflecting surface in said light beam movable elements in the device of FIG. 16. 
and rotatable about a first axis of rotation coincident 

with the beam axis of said light beam, a second reflect- PREFERRED EMBODIMENTS OF THE 

ing surface parallel to said first reflecting surface, later- 60 INVENTION 

ally offset with respect to said first axis of rotation and Referring to FIG. 1, numeral 10 designates a hetero- 

rotatable about said first axis of rotation together with dyne interferometer. The interferometer 10 includes a 

said first reflecting surface, said light beam being de- Helium-Neon laser 12 as light source. This is shown in 

fleeted by said first reflecting surface to said second FIG. 4. The laser 12 emits a laser beam 14. The laser 

reflecting surface, and being further deflected by said 65 beam 14 passes straight through a first beam splitter 16 

second reflecting surface in a direction parallel to said and through a second beam splitter 18. The laser beam 

axis of rotation, a third reflecting surface in said further then hits a mirror 20. Mirror 20 is rotatably mounted 

deflected light beam, said third reflecting surface being about a first axis 22 in a support 24. The support 24, in 
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turn, is mounted for rotation about a second axis 26 The beam 64, which has passed straight through the 
orthogonal to the first axis 22. The second axis is verti- polarizing beam splitter 62, is polarized parallel to the 
cal in FIG. 1. The mirror 20 can be rotated about these plane of the paper in FIG. 4. Beam 64 passes through a 
axes 22 and 26 by servomotors (not shown), which are half-wave plate 74 to provide polarisation normal to the 
energized by control signals on lines 2* and 30, respec- 3 plane of the paper in FIG. 4. This beam is deflected by 
tively. The angular position of the mirror about the two a mirror 76. The deflected beam 64 is substantially par- 
axes is detected by two highly accurate, high resolution allel to beam 14. Beam 64 passes through a modulator 
angle sensors (not shown). These angle sensors provide 78. The modulated beam emerging from modulator 78 
information about the angular positions of the mirror 20 passes straight through another polarizing beam splitter 
about the two axes 22 and 26 on lines 32 and 34, respec- 10 80 and impinges upon a photo-detector 82. 
tively. The operation of the retro-reflector 36, the beam 

The mirror 20 deflects the laser beam 14 towards a splitter 16 and the CCD picture sensor is shown in a 
retro-reflector 36. The retro-reflector 36 is rigidly at- schematic-perspective illustration in FIG. 2. 
tached to the movable end-effector 37 of a robot. The The retro-reflector 36 has three mutually orthogonal 
laser beam 14 is returned by the retro-reflector 36 as 15 reflecting surfaces 84, 86 and 88. In FIG. 2, these re- 
returned beam 38 parallel to its direction of incidence. fleeting surfaces 84, 86 and 88 are provided by three 
The returned beam 38 is again deflected by the mirror mirrors 90, 92 and 94, respectively. The mirrors 90, 92 
20 and is re-directed towards the laser 10. Also here, the and 94 form an inner corner of a cube. As can be seen in 
returned beam 38 is parallel to the outgoing laser beam FIG. 2, an incident beam 14 hits, for example, the re- 
14. In the path of rays of the returned beam 38, there are 20 fleeting surface 86 at 96, is then reflected to surface 84. 
the inclined beam splitting surfaces 40 and 42 of the The beam hits the surface 84 at 98. Surface 84 reflects 
beam splitters 16 and 18, respectively. the beam 14 towards surface 86. The beam hits the 

The beam splitter 18 directs part of the returned beam surface 86 at 100. The surface 86 reflects the beam and 

38 onto a position sensitive detector 44. The position returns it, parallel to the direction of the incident beam 

sensitive detector 44. The position sensitive detector 44 25 14, as the returned beam 38. 

provides output signals indicative of the lateral devia- The returned beam 38 gets to the beam splitter 16 

tions of the center point 46 of the retro-reflector 36 after deflection by the mirror 20. This deflection is not 

from the axis of the laser beam 14. These signals Ax and shown in simplified FIG. 2. The inclined surface 40 

Ay are applied to a processor 48. reflects part of the returned beam 38 as beam 102 to the 

The beam splitter 16 directs part of the returned beam 30 CCD picture sensor 50. Because of the beam expander 

16 onto a picture detecting sensor 50. The picture de- 70, the laser beam has a rather large diameter. In FIG. 

tecting sensor 50 is a CCD sensor. The picture detecting 2, numeral 104 designates the circular cross section of 

sensor is connected to a picture processing device 52. the returned beam 38, numeral 106 designates the eilipti- 

The picture processing device 52 provides information cal intersection of the beam 38 with the surface 40, and 

about the orientation of the retro-reflector 36 relative to 35 numeral 108 designates the circular cross section of the 

the laser beam 14. This information is applied to proces- beam 102 reflected by the surface 40, 

sor 48 through a data line 54. The edges 110, 112 and 114 along which the three 

The interferometer 10 provides information with mirrors are connected to form the retro-reflector 36 are 

respect to the distance 1 of the retro-reflector 36 from blackened to provide low-reflectivity strips. These low- 

the interferometer 10, measured along the path of the 40 reflectivity strips form a pattern of three intersecting 

laser beam 14. Also this signal is applied to the proces- straight lines in a picture generated in the plane of the 

sor 48 through line 56. CCD picture sensor. Such a picture is shown in FIG. 3. 

The processor 48 includes a controller 58, symbolized If you look into a retro-reflector of the present type, 

by a box. The controller 58 receives the error signals Ax you do not only see, for example, blackened edge 114 

and Ay, and provides output signals on lines 28 and 30 45 but also the mirror image of this blackened edge in 

for the control of the mirror 20 about its two axes 22 mirror 86, which appears as straight continuation of 

and 26, respectively. edge 114. A similar pattern is observed by the CCD 

The laser and interferometer arrangement is shown in picture sensor 50. The angles between these three 

greater detail in FIG. 4. straight lines 116, 118 and 120 are indicative of the 

The beam 14 from the laser 12 is deflected by mirror 50 orientation of the retro-reflector relative to the direc- 

60 and is split into two partial beams by a polarizing tion of laser beam 14. 

beam splitter 62, The beam reflected towards the retro- The picture processing device 52 evaluates the pic- 
reflector is still designated by numeral 14. The beam ture observed by the CCD picture sensor 50 and, to- 
passing straight through the beam splitter is designated gether with processor 48 provides the orientation of the 
by reference numeral 64. 55 retro-reflector 36 in a device-fixed coordinate system. 

Reflected beam 14 is polarized normal to the plane of The polarizing beam splitter 18 similarly directs part 

the paper in FIG. 4. A half-wave plate 66 provides of the returned beam to the position sensitive detector 

polarization parallel to the plane of the paper in FIG. 4. 44. The position sensitive detector 44 provides error 

The beam thus passes through a polarizing beam splitter signals indicative of the deviation of the beam axis of 

68 and enters a beam expander 70. The beam expander 60 laser beam 14 from the center point 46 of the retro- 

is an optical system which converts the narrow laser reflector 36. The controller 58 through lines 28 and 30 

beam into a beam having a larger diameter. The thus controls the mirror angles a m and fi m to minimize the 

expanded beam 14 passes through the two polarizing deviation. Thus the expanded laser beam 14 is caused to 

beam splitters 16 and 18. A quarter-wave plate 72 pro- . continuously track the retro-reflector 36. 

vides a circularly polarized beam. This beam 14 is di- 65 The portion of the returned light beam 38, which has 

rected, as shown in FIG. 1, to the retro-reflector 36. passed straight through the polarizing beam splitters 18 

The deflection of the beam 14 by mirror 20 is not shown and 16, passes through the beam expander 70 in reverse 

in FIG. 4. direction and is deflected by the polarizing beam splitter 
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68. The light deflected by the polarizing beam splitter 
68 is polarized normal to the plane of the paper in FIG. 
4, the same way as the beam 64 passing through the 
modulator 78. The two beams 64 and 38 are superim- 
posed by the polarizing beam splitter 82 and caused to 
exhibit interferences at photo-detector 82. From the 
counting of interference fringes, variations of the dis- 
tance 1 can be measured with great accuracy. If the 
initial distance is known, the interferometer 10 provides 
the absolute value of the distance 1. This is a known 
technique and. therefore, is not described in detail. 

From the evaluation of the picture received by CCD 
picture sensor 50, the angles of orientation of the retro- 
reflector 36 relative to a laser beam-fixed coordinate 
system can be determined. From the angles a m and 0 m 
measured at the mirror 20, the direction of laser beam 14 
can be derived. This permits computation of the orien- 
tation of the retro-reflector 36 relative to a device-fixed 
coordinate system. 

The orientation of the laser beam 14 and the distance 20 
1 of the retro-reflector provide the coordinates x, y and 
z in a device-fixed coordinate system. 

The orientation <f>,0,i|/ of the retro-reflector 36 (and 
thereby of the end-effector 37) and the position x, y, z of 
the retro-reflector 36 in the device-fixed coordinate 25 
system is outputted at an output 122 of the processor 48. 

The computations to be carried out by the processor 
48 will be summarized briefly hereinbelow with refer- 
ence to FIGS. 5 and 6. 

At first, the deflection of the laser beam 14 by the 
mirror 20 is disregarded as in FIG. 2. The orientation 
angles of the retro-reflector 36 with respect to a coordi- 
nate system fixed with respect to the laser beam 14 can 
be derived from the picture obtained in the plane of the 
CCD picture sensor 50. Such a picture is shown in FIG. 
3. The orientation thus obtained is then to be trans- 
formed into a device-fixed coordinate system taking 
into account the deflection angles of the mirror 20 and 
the deflection angles of the laser beam 14 caused 
thereby. 

The reference direction of the retro-reflector 36 is a 
straight line along the diagonal of the notional cube 
defined by the three mirrors 84, 86 and 88. This straight 
line passes through the center point 46 of the retro- 
reflector 36. A coordinate system is defined by the three 45 
mirror edges 110, 112 and 114 of the retro-reflector 36. 
The orientation of the retro-reflector 36 relative to a 
stationary coordinate system is defined by three angles 
through which the stationary coordinate system would 
have to be rotated in order to coincide with the retro- 50 
reflector coordinate system. In the present case, the 
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angle ^. Then the 4, B"-coordinate system is rotated 
about the stationary y^-axis by the pitch angle 0. Even- 
tually the "B"-coordinate system is rotated about the 
stationary z^-axis by the roll angle 

FIG. 6 illustrates the angles a^, fip, y p and 6 P appear- 
ing in the picture, which is observed in the plane of the 
CCD picture sensor 50. As explained with reference to 
in FIG. 3, this picture contains a pattern of three 
straight lines representing the edges 110, 112 and 114 of 
the retro-reflector 36 and their mirror images. These 
straight lines are defined by three vectors Vi, V2 and 
V3. The angles mentioned above are the angles between 
these vectors and the angle between vector Vi and the 
direction of the x-axis of the "A"-coordinate system 
mentioned above. It can be shown, that the roll, pitch 
and yaw angles defined with reference to FIG. 5 and 
the angles of FIG. 6 are interrelated by the following 
equations: 
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This provides the orientation of the retro-reflector 36 
relative to a coordinate system movable with the laser 
beam 14 upon rotation of the mirror 20 about its two 
axes 22 and 26, It is desired to obtain the orientation of 
the retro-reflector 36 with reference to a stationary, 
"device-fixed38 coordinate system. This requires a fur- 
ther transformation: 
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roll, pitch and yaw angles are used to define this orien- 
tation. This is illustrated in FIG. 5. The stationary coor- 
dinate system is designated by 44 A". This stationary 
coordinate system uses the direction of the laser beam 
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wherein a and /3 are the elevation and azimuth angles of 



14 as its z-axis, the remaining two axes being orthogonal 65 the laser beam 14 directed to the retro-reflector 36 and 

thereto. The coordinate system referenced to the retro- <f> is the angle between the laser beam 14 emitted by the 

reflector is designated "B". The "B"-coordinate system interferometer 10 and the vector perpendicular to the 

is first rotated about the stationary x^-axis by the yaw plane of the mirror 20. 
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FIG. 7 shows another embodiment in a schematic- 
perspective illustration similar to FIG. 2. Correspond- 
ing elements are designated by the same reference nu- 
meral in both figures. 

In the embodiment of FIG. 7, the retro-reflector 36 is 
a solid glass body having three mutually orthogonal 
surfaces 124 (the rear surface in FIG. 7), 126 and 128, 
and a front surface 130. The three mutually orthogonal 
surfaces define one corner of a notional cube. A refer- 
ence direction is defined by a diagonal of this notional 
cube passing through the center point 46. The front 
surface is normal to this reference direction. The three 
mutually orthogonal surfaces are reflecting by total 
reflection. 

The front surface 130 carries a mark 132 in the form 
of two mutually orthogonal, etched lines 134 and 136. 

The laser beam 14 and the returned beam 38 are 
shown with a slight lateral offset. This offset will be 
detected by the position sensitive detector 44. The sig 



10 



10 



15 



rigidly attached to the retro-reflector 36. In the embodi- 
ment of FIG. 11, this rigid body consists of an L-shaped 
wire. This wire produces a similar pattern as the etched 
lines 134, 136 on the front surface 130 of the retro- 
reflector 36 in FIG. 7. 

In the embodiment of FIG. 12, the retro-reflector 36 
has no blackened mirror edges. Only a L-shaped wire 
150 is attached to the retro-reflector 36. The picture of 
the wire 150 is provided by the returned beam 38 on a 
CCD picture sensor 152. To this end, part of the return- 
ing beam 38 is deflected by a first beam splitter 154. Part 
of the returned beam 38 passes straight through the first 
beam splitter 154 and gets to a second beam splitter 156. 
The second beam splitter 156 again deflects part of the 
returned beam 38. This deflected part is directed on a 
position sensitive detector 158. 

Normally, the intersection of the pictures of the mir- 
ror edges 110, 112 and 114 provides an indication of the 
center point 46 of the retro-reflector 36. If the mirror 



nals from the position sensitive detector will be used, as 20 edges 110, 112 and 114 are not blackened, the informa- 
described, to track the retro-reflector 36 with the laser tion about the center point has to be derived from else- 
heam 14. where. In the embodiment of FIG. 12, the position 

The three mutually orthogonal surfaces cause the sensitive detector 158, which responds to the deviation 
incident beam 14 to be returned parallel to the direction of the laser beam from the center point, provides this 
of incidence ar returned beam 38. Part of the beam 38 is 25 information. In the complete measuring system as illus- 



deflected towards the CCD picture sensor 50. FIG. 8 
shows the picture obtained, with this type of mark 132, 
in the plane of the CCD picture sensor. Again the lines 
134 and 136 appear twice in this picture, namely once 
directly and once as a mirror image. 

Evaluation of this picture can be accomplished in a 
similar way as that described with reference to FIGS. 1 
to 6. 

The embodiment of FIG. 9 is similar to that of FIG. 
7. Corresponding elements bear the same reference 
numeral in both figures. The front surface 130 carries an 
etched mark consisting of two intersecting straight lines 
136 and 138. 

The embodiment of FIG. 10 is similar to that of FIG. 



trated in FIG. 1, this position sensitive detector 156 is 
provided anyhow. 

The measuring of the pictures (frames per second) by 
the CCD picture sensor should be accomplished at a 
30 rather high measuring rate in order to permit accurate 
tracking of the retro-reflector. The measuring rate 
ought to be more than 1 kilocycles per second. In order 
to permit higher measuring rates, which cannot be 
achieved by conventional CCD picture sensors, the 
35 CCD picture sensor, preferably, consists of a plurality 
of spaced CCD line sensors. Though such CCD line 
sensors detect only a fraction of the total picture, unam- 
biguous reconstruction of the whole picture is possible. 
The picture consists of simple linear structures only. 



2. Corresponding elements bear the same reference 40 Therefore a few lines of this picture provide all the 



numeral in both figures. In the embodiment of FIG. 10, 
the retro-reflector 36 consists of three mirrors 90, 92 
and 94. The three mirrors are mutual orthogonal and 
form three reflecting surfaces 84, 86 and 88, respec- 
tively, on the inner surface of a cube corner. The mark 45 
consists of a separate body 140 rigidly attached to the 
retro-reflector 36. In the embodiment of FIG. 10, this 
rigid body consists of a square frame 140 and a pair of 
intersecting elements 144 and 146 like the cross-bars of 

a window. The body 140 consists of transparent or 50 of three mutually orthogonal mirrors 90, 92 and W. 
translucent plastics. This permits the CCD picture sen- Beam splitters 158 and 160 are arranged in the paths of 
sor to discriminate between the shadows or pictures of the incident laser beam 14 and of the returned light 
the edges 110, 112 and 114 of the mirrors 90, 92 and 94 beam 38. The incident light beam 14 passes straight 
and the structure of the body 140. through the beam splitters 158 and 160. Numeral 162 

This body 140 produces also a shadow pattern in the 55 designates the cross section of the expanded incident 

iofi<» o/^r\ — :~» ~ m *¥*!_• ^ i i . «j -r-t • ■ 



information required. Thereby, however, the number of 
data per measuring step is reduced considerably. It 
becomes possible to increase the measuring rate accord- 
ingly. 

Such an arrangement is illustrated in FIG. 13. FIG. 
13 is a schematic-perspective view, similar to FIG. 13, 
of a device using a plurality of longitudinal and trans- 
versal CCD line sensors. 

Referring to FIG. 13, the retro-reflector 36 consists 



picture on the CCD picture sensor 50. This pattern 
permits determination of the orientation of the retro- 
reflector 36. Evaluation of this picture can be accom- 
plished in a similar way as that described with reference 
to FIGS. 1 to 6. 

The embodiment of FIG. 11 is similar to that of FIG. 
10. Corresponding elements bear the same reference 
numeral in both figures. In the embodiment of FIG. 11, 
the retro-reflector 36 again consists of three mirrors 90, 



laser beam 14. The laser beam 14 intersects the inclined 
planes of the beam splitters 158 and 160 in ellipses 164 
and 166, respectively. The returned light beam 38 inter- 
sects the planes of the beam splitters 158 and 160 in 
60 ellipses 168 and 170, respectively. Parts of the returned 
light beam 38 are reflected by the beam splitters 158 and 
160 towards detector arrangements 172 and 174, respec- 
tively. The detector arrangement 172 consists of three 



CCD line sensors 176, 178, 180 and 182. These sensors 
92 and 94. The three mirrors are mutual orthogonal and 65 are arranged parallel to each other and to the unde- 
forra three reflecting surfaces 84, 86 and 88, respec- fleeted, returned beam 38 in a plane, which is normal to 
lively, on the inner surface of a cube corner. The mark, the direction of the beam portion deflected by beam 
also in this embodiment, consists of a separate body 148 splitter 158. The detector arrangement 174 consists of 
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four CCD line sensors 186, 188, 190 and 192. These 
sensors are arranged parallel to each other and trans- 
verse to the undeflected, returned beam 38 in a plane, 
which is normal to the direction of the beam portion 
deflected by beam splitter 160. 

FIG. 14B shows schematically how a picture or 
shadow of a body attached to the retro-reflector, such 
as the wire 148 of FIG. 11, is formed in the plane of 
each of the detector arrangements 172 and 174. This 
picture is a "L" 196 together with its mirror image 198. 
Also formed are straight line pictures 200, 202 and 204 
caused by the edges of the mirrors 90, 92 and 94. The 
longitudinal CCD line sensors 176, 178, 180 and 182 are 
represented by vertical straight lines in FIG. 14B. The 
transversal CCD line sensors 186, 188, 190 and 192 are 
designated by horizontal straight lines in FIG. 14B. 

FIG. 14A illustrates the various sensor elements of 
the CCD line sensors which detect a shadow of the 
picture pattern shown in the right hand portion. These 
sensor elements are located at the intersections of the 
pattern lines with the sensor "lines". The detector ele- 
ments 206 shown by squares represent the straight lines 
200, 202 and 204 resulting from the mirror edges. The 
detector elements shown by crosses 208 (x) represent 
the L-shaped patterns caused by wire 148. 

It can be seen, that the whole pattern of of FIG. 14B 
can be reconstructed from the sensor elements marked 
by the squares and crosses. It takes, however, much less 
time to sample the picture information from the CCD 
line sensors than from a nearly continuous, two-dimen- 
sional array of sensor elements. In FIG. 14A, the longi- 
tudinal and transversal CCD line sensors have been 
shown one on top of the other. As this is not possible in 
practice, the actual arrangement is that of FIG. 13 with 
two beam splitters 158 and 160. The informations ob- 
tained are, of course, identical 

The cardanically mounted mirror 20 of FIG. 1 can be 
replaced by an optical structure of the type shown in 
FIGS. 15 and 16. The expanded laser beam 14 passes 
straight through polarizing beam splitters 16 and 18 and 40 
is deflected by a reflecting surface 210 of a prism 212. 
The laser beam 14 is directed to a reflecting surface 214 
of a prism 216. The surface 210 deflects the laser beam 
14 by 90°, whereby the laser beam 14 is now directed 
radial with respect to the original beam axis. The sur- 45 
face 214 deflects the laser beam 14 again by 90*. 
Thereby the laser beam 14 is again parallel to its original 
beam axis but laterally offset with respect thereto. The 
laterally offset laser beam 14 is again deflected radially 
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of rotation and & directly represent the angles through 
which the laser beam 14 is deflected. This is different 
from the arrangement with the mirror 20, where each 
rotation of the mirror causes deflection of the beam 
through twice the angle. 
1 claim: 

1. A device for non-contacting measurement of the 
orientation in space of a measuring object, comprising 

a retro-reflector rigidly attached to said object, 
reference mark means provided on said retro-reflec- 
tor, 

light source means for generating a collimated light 
beam, 

beam directing means for directing said collimated 
light beam onto said retro-reflector, said light beam 
being returned by said retro-reflector substantially 
into itself, 

means for receiving said returned light beam for 
forming therefrom a picture of said reference mark 
means, 

picture detecting means for detecting said picture of 
said reference mark means and for providing corre- 
sponding picture information, and 

processing means for deriving, from said picture in- 
formation, output data representing the orientation 
in space of said retro-reflector and thereby the 
orientation in space of said measuring object. 

2. A device as claimed in claim 1, wherein said retro- 
reflector comprises three mutually orthogonal reflect- 
ing surfaces. 

3. A device as claimed in claim 2, wherein said retro- 
reflector is a solid body of transparent material having 
three mutually orthogonal surfaces, said orthogonal 
surfaces reflecting light by total reflection and repre- 
senting said reflecting surfaces. 

4. A device as claimed in claim 1, wherein said refer- 
ence mark means are reduced-reflection strips along 
adjacent edges of said reflecting surfaces. 

5. A device as claimed in claim 1, wherein said refer- 
ence mark means comprise separate bodies attached to 
said retro-reflector and extending into said light beam. 

6. A device as claimed in claim 1, wherein said at- 
tached bodies define elongated structures. 

7. A device as claimed in claim 1, wherein said light 
source means comprise a laser emitting a laser beam. 

8. A device as claimed in claim 7, wherein said light 
source means further comprise beam expander means in 
the path of the laser beam for providing a collimated 



inwards by a reflecting surface 220 of a prism 222. The 50 light beam of larger diameter than that of said laser 



laser beam 14 is then anti-parallel to the beam deflected 
by the surface 210. The prisms 212, 216 and 222 to- 
gether are rotatable about an axis 218, which coincides 
with the original beam axis. The angle of rotation is 
designated /J in FIG. 16. 55 

A prism 224 having a reflecting surface 226 is ar- 
ranged on the axis 18 and in the path of the beam re- 
flected by reflecting surface 220. This prism is rotatable 
about an axis 228. The angle of rotation of the prism 224 
about axis 228 is designated a. The cross sections of all 60 
of the prisms 212, 216, 222 and 224 are isosceles trian- 
gles having one right angle and two angles of 45* each. 
The reflecting surfaces 210, 214, 220 and 226 extend 
along the hypotenuses of the triangles and are arranged 
at an angle of 45° to the beam axes. Thereby the beams 65 
are deflected by 90% 

The arrangement descnoeo with reference to FIGS. 
15 and 16 offers the advantage that the measured angles 



beam. 

9. A device as claimed in claim 1, wherein 

said light beam passes through a stationary section, 
where the path of rays of the light beam is station- 
ary. 

said means for receiving said returned light beam 
comprising semi-transparent mirror means ar- 
ranged in said stationary section of said returned 
light beam for deflecting part of said returned light 
beam to a plane where a picture with a pattern 
caused by said reference mark means is formed, 

said picture detecting means being arranged in said 
plane. 

10. A device as claimed in claim 1, wherein said de- 
tecting means comprise a CCD sensor. 

11. A device as claimed in claim 10, wherein said 
CCD sensor comprises a number of line scan sensors. 

12. A device as claimed in claim 1, wherein 
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said beam directing means comprises movable reflect* 
ing means for tracking, with said light beam, a 
movable measuring object. 

13. A device as claimed in claim 12 and further com- 
prising: 

detector means responsive to the lateral offset of the 
incident and returned beams caused by the reflec- 
tion at said reflecting surfaces of said retro-reflec- 
tor, and 

servo means controlled by said detector means for 
moving said reflecting means to reduce this lateral 
offset to zero and thereby to track said retro-reflec- 
tor with said light beam. 

14. A device as claimed in claim 13, and further com- 
prising interferometer means for measuring the distance 
of said measuring object from said light source means to 
provide a distance information. 

15. A device as claimed in claim 14, and further com- 
prising 

means for sensing the movement of said movable 20 
reflecting means of said beam directing means to 
provide beam direction information, and 

computing means, to which said distance information 
and said direction information is applied to provide 
output data indicative of the position of said retro- 
reflector, and thereby of said measuring object. 

16. A device as claimed in claim 13, wherein said 
beam directing means comprises a cardanically 
mounted mirror, said mirror being movable by a first 
servomotor about a first cardan axis and being movable 
by a second servomotor about a second cardan axis. 

17. A device as claimed in claim 13, wherein said 
beam directing means comprises 

a first reflecting surface in said light beam and rotat- 
able about a first axis of rotation coincident with 
the beam axis of said light beam, 

a second reflecting surface parallel to said first re- 
flecting surface, laterally offset with respect to said 
first axis of rotation and rotatable about said first 
axis of rotation together with said first reflecting 40 
surface, said light beam being deflected by said first 
reflecting surface to said second reflecting surface, 
and being further deflected by said second reflect- 
ing surface in a direction parallel to said axis of 
rotation, 45 

a third reflecting surface in said further deflected 
light beam, said third reflecting surface being rotat- 
able with said first and second reflecting surfaces 
and being arranged to re-deflect said light beam 
into the direction of a second axis of rotation or- 50 
thogonal to said first axis of rotation, and 

a fourth reflecting surface in said re-deflected light 
beam on said second axis of rotation, said fourth 
reflecting surface being rotatable about said second 

55 
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axis of rotation to direct said light beam radially 
therefrom. 

18. A device for non-contacting measurement of the 
orientation in space of a movable measuring object, 
comprising 

a retro-reflector having three mutually orthogonal 
reflecting surfaces, said retro-reflector being rig- 
idly attached to said measuring object, reference 
mark means provided on said retro-reflector, 

a laser emitting a laser beam and beam expander 
means in the path of the laser beam for providing a 
collimated light beam of larger diameter than that 
of said laser beam, 

said light beam passing through a stationary section, 
where the path of rays of the light beam is station- 
ary, to beam directing means for directing said 
collimated light beam onto said retro-reflector, said 
light beam being returned by said retro-reflector 
substantially into itself, said beam directing means 
comprising movable reflecting means for tracking, 
with said light beam, said movable measuring ob- 
ject 

semi-transparent mirror means arranged in said sta- 
tionary section of said returned light beam for de- 
flecting part of said returned light beam to a plane 
where a picture with a pattern caused by said refer- 
ence mark means is formed, 

picture detecting means, arranged in said plane, for 
detecting said picture of said reference mark means 
and for providing corresponding picture informa- 
tion, and 

processing means for deriving, from said picture in- 
formation, output data representing the orientation 
in space of said retro-reflector and thereby the 
orientation in space of said measuring object. 

19. A device as claimed in claim 18, wherein said 
detecting means comprise a CCD sensor. 

20. A device as claimed in claim 19, wherein said 
CCD sensor comprises a number of line scan sensors. 

21. A device as claimed in claim 18, and further com- 
prising interferometer means for measuring the distance 
of said measuring object from said light source means to 
provide a distance information. 

22. A device as claimed in claim 21, and further com- 
prising 

means for sensing the movement of said movable 
reflecting means of said beam directing means to 
provide beam direction information, and 

computing means, to which said distance information 
and said direction information is applied to provide 
output data indicative of the position of said retro- 
reflector, and thereby of said measuring object. 
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